float64 later_dis_debug
float64 speed_cmd_debug
float64 speed_mps_debug
float64 lookahead_distance_debug